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摘 要 : [目的 /意义 ] 传统 路 径 跟 踪 模 型 预测 控制 (Model Predictive Control, MPC) 大 多 采用 固定 时 域 ， 较 少 考 
虑 道路 弯曲 和 曲率 变化 的 影响 ， 使 得 机 器 人 在 曲线 路 径 作 业 过 程 中 的 跟踪 效果 和 适应 性 都 较 差 。 因 此 ， 设 计 了 一 
种 自 适 应 时 域 MPC 控制 器 并 使 其 满足 自主 制 草 等 复杂 作业 要 求 。[ 方 法 ] 首先 ， 根 据 割 草 机 器 人 的 速度 确定 前 方 
参考 路 径 的 预 瞄 区 域 ， 并 计算 预 瞄 区 域内 的 参考 路 径 曲 度 因 子 和 曲 度 变化 因子 ,分别 用 于 描述 曲率 和 曲率 变化 大 
小 。 然后， 将 二 者 作为 模糊 控制 器 的 输入 信息 ， 用 于 自 适应 调节 MPC 的 预测 时 域 ,， 同时， 根据 预测 时 域 及 曲 度 变 
化 因子 调整 控制 时 域 ， 以 增强 控制 器 对 路 径 弯 曲 变 化 的 适应 性 并 降低 计算 资源 。 此 外 ,设计 一 种 MPC 事 件 触 发 执 
行 机 制 ， 进 一 步 提 升 MPC 的 实时 性 。[ 结 果 和 讨论 ] 与 固定 时 域 的 MPC 进行 对 比试 验 ， 自 适应 时 域 MPC 控制 器 的 
最 大 横向 误差 绝对 值 和 最 大 航向 误差 绝对 值 分 别 控制 在 11 cm 和 0.13 rad 以 内 ， 其 平均 求解 时 间 比 最 大 时 域 MPC 减 
少 10.9 ms。[ 结 论 ] 自 适 应 时 域 MPC 不仅 能 够 保证 割 草 机 器 人 对 曲线 路 径 的 跟踪 精度 ， 同 时 降低 了 MPC 求 解 计 算 
量 并 提高 了 控制 实时 性 ， 解 决 了 固定 时 域 MPC 的 控制 精度 与 计算 量 之 间 的 矛盾 。 
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0 8| = 制 (Model Predictive Control, MPC) ”等 。 与 其 他 


A 
i hc i ZA [ 问题 HR 
随 着 国家 对 工业 智能 化 的 重视 ， 移 动机 器 人 领 te gn ee 
域 正 在 迅速 发 展 。 智 能 割 草 机 器 人 作为 机 器 人 技术 应用 mm ^ lii 


MEL CA dar MU Gas as ea s 目前 ， 国 内 外 对 基于 MPC 的 路 径 跟 踪 控 制 进 


减少 了 传统 手工 作业 的 劳动 强度 和 环境 污染 “。 而 。 行 了 大 量 的 研究 。 有 研究 基于 模型 预测 理论 设计 眼 


路 径 跟踪 控制 作为 智能 农机 自动 导航 的 关键 技术 之 — 踪 控制 器 ， 采 用 泰勒 级 数 对 农业 机 械 模型 进行 线性 
一 ， 对 于 提高 智能 市 萤 机 器 人 作业 效率 和 作业 质量 ”化 处 理 ， 有 效 减少 路 径 跟 踪 过 程 的 计算 负担 口 。 
发 挥 至 关 重 要 的 作用 “。 有 目前， 用 于 路 径 跟 踪 控 制 Tan 等 在 MPC 控 制 器 设计 过 程 中 ， 综 合 考虑 了 
的 主流 方法 有 : 比例 积分 微分 (Proportional Inte- 由 分 配 误差 和 偏 置 模型 中 外 力 引起 的 扰动 ， 增 强 了 
gral Derivative, PID) ^ ,. Fx Jj ds qd ^ .— A HR Ex MPC 在 路 径 跟 踊 中 的 鲁 棒 性 和 稳定 性 。Bettega 和 
(Pure Pursuit) 5 、 滑 模 控 制 “、 线 性 二 次 调节 器 Richiedei "设计 了 一 种 新 型 的 基于 线性 化 模型 的 
(Linear Quadratic Regulator, LOR) ^ , 5 AY fjr jj HE MPC 人 公式， 并 以 可 忽略 的 误差 和 延迟 跟踪 时 变 作 
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为 参考 ， 实 现 更 高 精度 的 路 径 跟 踪 。 李 俊 等 ” 通 
过 确定 车 辆 在 直线 道路 上 不 打滑 的 最 大 纵向 速度 与 
路 面 曲率 的 函数 关系 设计 了 一 种 改进 的 MPC 算 法 ， 
提高 了 车 辆 在 复杂 道路 条 件 下 的 路 径 跟 踪 准 确 性 、 
FRESE, KERT O 将 状态 扩展 模型 预 
测 与 转角 补偿 相 结合 ， 利 用 状态 轨迹 的 近似 线性 化 
方法 对 非 线性 模型 进行 线性 化 ， 降 低 了 最 优 控制 量 
的 求解 时 间 。 

上 述 MPC 控 制 嚣 全 都 采用 固定 时 域 ， 而 预测 
时 域 和 控制 时 域 对 路 径 跟踪 控制 精度 及 稳定 性 会 产 
生 很 大 影响 ， 固 定时 域 难以 使 MPC 在 复杂 环境 中 
达到 期 望 的 路 径 跟 踪 控 制 效 果 UU. Hag, xP AR 
时 域 的 MPC 方 法 研究 较 少 。 范 贤 波 等 ”将 横向 和 
纵向 车 速 作为 模糊 控制 器 输入 ， 用 于 自 适 应 调节 
MPC 的 预测 时 域 和 控制 时 域 ， 提 高 了 车 辆 在 高 速 
时 的 稳定 性 。Lin 等 ” 采用 模糊 理论 确定 在 线 优化 
的 时 域 因 子 ， 再 根据 加 权 因 子 调整 预测 时 域 和 控制 
时 域 ， 用 于 提高 不 同 速度 下 的 适应 性 和 稳定 性 。 另 
外 ，Zhou 等 O 将 遗传 算法 与 MPC 相 结合 ， 利 用 遗 
传 算法 计算 实时 车 速 、 车 辆 姿态 和 路 况 下 的 最 优 时 
域 参数 ， 实 现 自 适应 MPC。 

在 上 述 研 究 中 ， 变 时 域 MPC 主要 基于 车 速 、 
横向 误差 等 指标 调节 时 域 大 小 ， 但 没有 考虑 路 径 曲 
率 以 及 曲率 变化 对 MPC 控 制 精 度 的 影响 ， 难 以 保 
证 割 草 机 器 人 在 曲率 变化 较 大 的 曲线 路 径 中 完成 精 
准 作业 。 为 了 有 和 针对 性 地 解决 割 草 机 器 人 对 曲线 路 
径 跟 踪 精 度 不 高 ， 以 及 MPC 计算 求解 量 较 大 的 问 
题 ， 本 研究 设计 了 一 种 自 适应 时 域 MPC 控制 器 ， 
能 够 根据 参考 路 径 的 曲率 以 及 曲率 变化 优化 MPC 
的 时 域 ， 从 而 保证 割 草 机 器 人 对 曲线 路 径 的 跟踪 精 
度 ， 并 降低 MPC 求 解 计 算 量 。 另 外 ， 设 计 了 一 种 
MPC 事 件 触发 执行 机 制 ， 进 一 步 减 少 MPC 计算 
负荷 。 

1 割 草 机 器 人 建 模 

图 1 是 自主 设计 的 制 草 机 器 人 模型 俯视 图 ， 通 
过 两 个 后 轮 差 速 驱动 实现 运动 控制 。 图 中 XO7 表 示 
全 局 坐标 系 ; Gxy 表 示 制 草 机 器 人 的 局 部 坐标 系 ; 
点 G 表 示 两 后 轮轴 中 心 位 置 ; 24 为 两 后 轮 中 心 距 
离 ; 7 为 后 轮 半 径 。 

如 果 采 用 多 自由 度 动力 学 建立 割 草 机 器 人 模 
型 ， 虽 然 可 以 提高 控制 器 的 精确 性 ， 但 是 模型 的 复 
杂 度 会 大 大 增加 控制 器 的 计算 量 而 导致 实时 性 较 
差 。 因 此 ， 本 人 研究 采用 制 草 机 需 人 的 运动 学 模型 ， 


图 1 割 草 机 器 人 模型 俯视 图 
Fig. 1 Top view of the mowing robot model 
以 降低 问题 的 求解 难度 ， 提 高 控制 的 实时 性 ， 如 公 
式 (1) 所 示 。 


x coSO 0 
Yl=| sind 0 M (1) 
6 0 af” 


式 中 : x、y 分 别 为 制 草 机 器 人 在 坐标 系 XOY 中 
的 横 坐 标 和 纵 坐 标 ，m; ONAA, rad; vý 
速度 ，m/s; w 为 角速度 ，rad/s。 

假设 参考 路 径 上 任意 点 都 满足 上 述 运 动 学 方 
程 ， 在 参考 点 [x,，y,，9, | 处 对 公式 (1) 利用 泰勒 
级 数 展开 进行 线性 化 处 理 ， 得 到 公式 (2)。 


X-X,| [0 0 -wsin8,][ x - x, 
y-x»,- f 0 v,cos i E 1 
6-6, 0 0 0 0 - 0, (2) 
cos, 0 
| sin 0, | 
0 1 AZ 


式 中 : v, 为 参考 点 处 的 线 速度 ，m/s; w, 为 参 
考点 处 的 角速度 ，rad/s。 

设 采 样 时 间 为 7， 使 用 欧 拉 公式 对 公式 (2) 进 
行 离散 化 处 理 ， 得 到 制 草 机 融 人 的 离散 化 误差 方 
程 ， 如 公式 (3) 所 示 。 

x(k+1)=ax(k)+bū(k) 

1 0 -Tv,sinð, 
Zr 1 rest 
0 0 1 
Tcos0, 0 


TsinO, 0 
0 T 

2 自 适 应 时 域 模 型 预测 控制 器 设计 
本 研究 设计 的 自 适应 时 域 模 型 预测 控制 器 的 系 

统 结构 如 图 2 所 示 。 首 先 ， 基 于 公式 (3) 表示 的 


(3) 


b= 
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离散 化 误差 方程 ， 推 导出 割 草 机 器 人 的 预测 模型 。 
然后 ， 根 据 参 考 路 径 信息 和 制 草 机 器 人 作业 速度 ， 
动态 确定 预 眶 区 域 范围 。 再 通过 计算 曲 度 因子 上 和 
曲 度 变 化 因子 记分 别 反映 预 眶 区 域 起 始 处 的 参考 路 
径 弯 曲 程度 大 小 以 及 整个 预 瞒 区 域内 的 参考 路 径 弯 
曲 变 化 程度 大 小 。 其 次 ,将 六、f. 作 为 MPC 自 适 应 
时 域 模块 中 的 模糊 控制 器 的 输入 ， 对 MPC 的 预测 
时 域 N, 进 行 自 适 应 优化 ， 同 时 ， 根 据 所 获得 的 N， 
以 及 f 合 理 调整 控制 时 域 N.， 以 提高 控制 器 对 曲率 
变化 的 曲线 路 径 的 适应 性 并 在 一 定 程度 上 减少 计算 
量 。 再 者 ,通过 构建 MPC 事件 触 发 执行 机 制 ， 进 
一 步 降 低 MPC 求 解 的 计算 负荷 ， 提 高 控制 实时 性 。 
最 后 ， 在 满足 运动 学 和 动力 学 约束 的 条 件 下 ,求解 
出 驱动 电机 的 最 优 控 制 量 ， 保 证 市 草 机 器 人 的 路 径 
跟踪 控制 精度 。 

[sime nens 预 瞄 区 域 | 速度 信息 [ren 


曲 度 因 子 
曲 度 变 化 因子 


MPC 自 适应 
时 域 模块 


ALONE d 
路 径 信息 控制 时 域 


最 优 控制 量 
定位 信息 


执行 模块 
图 2 自 适应 时 域 MPC 控 制 系统 结构 框图 
Fig.2 Structural diagram of adaptive time horizon MPC 


control System 
2.1 MPC 控 制 器 设计 


结合 公式 〈3)， 将 当前 时 刻 的 状态 量 与 前 一 时 
刻 的 控制 量 组 合 为 新 的 状态 量 ， 如 公式 (4) 所 示 。 
«| is | (4) 
ü(k- 1) 

则 新 的 状态 空间 表达 式 如 公式 (5) 所 示 。 
E(k + 1) =A€(k) + BAü(k) 
y(k) 2 Ce(k) 


Per | 
0 I, 


a 


C-[I, 0] 
Aŭ (k) =a(k) - ü(k- 1) 


(5) 


式 中 : LS LATA m BY AL n AERE; m 
为 控制 量 维度 ; n 为 状态 量 维 度 。 

MPC 的 预测 时 域 设 为 N,， 控 制 时 域 设 为 N.。 
假设 当前 时 刻 为 :， 利用 当前 状态 信息 定义 未 来 时 
域内 系统 的 输入 向 量 AU, CK) 和 预测 输出 向 量 
Y,(k), WAR (6) 和 公式 (7) 所 示 。 

Aù (Kk) 
eno Aa (k + 1lk) 


AU, (k) = | (6) 
Aii(k+N.— 1k) 
n(k+ 1|k) 
Zao (7) 
n(k + Nlk) 


最 终 经 过 递 推 ， 得 到 预测 输出 方程 如 公式 (8) 


Y, (k) =A,¢(k) + B,AU, (k) 


A, - [CA. CA-cA"] 


CA""'B CA"^B CA" "B 
为 保证 割 草 机 器 人 能 够 高 效 、 稳 定 地 跟踪 参考 
路 径 ， 将 系统 状态 误差 和 控制 误差 变化 引入 到 目标 
函数 中 ， 得 到 如 公式 (9) 所 示 的 目标 函数 。 
TvCD- IsCbu| «aus co 


min J= 


E 
(9) 
式 中 : p 为 权重 系数 ; e WEAF; Q. RON 

权重 矩阵 ;Jr (ke 为 预测 时 域内 的 参考 输出 。 目 

标 函 数 的 第 1 项 反映 了 控制 系统 对 参考 路 径 的 跟随 

能 力 ; 第 2 项 反映 了 对 控制 量变 化 的 约束 ， 以 保证 

制 草 机 器 人 在 运动 过 程 中 尽 可 能 不 会 出 现 速度 、 航 

向 角 、 加 速度 的 剧烈 变化 ， 在 一 定 程 度 上 保证 割 草 

机 器 人 的 稳定 性 。 第 3 项 通过 引入 松弛 因子 来 增强 

可 行 域 的 解 ， 从 而 保证 优化 问题 存在 最 优 解 。 
为 了 得 到 多 约束 条 件 下 的 最 优 控制 序列 ， 采 用 

二 次 规划 方法 进行 求解 ， 即 将 带 约 束 的 最 优 问题 转 

化 为 二 次 规划 (Quadratic Programming, QP) 问题 

进行 数值 求解 。 将 公式 (8) 带 入 目标 函数 中 ， 则 

公式 〈9) 可 以 转换 成 如 公式 (10) 所 示 的 二 次 规 

划一 般 形 式 。 
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minw, ,J-[AU, GO". e] H[AU, GO. e] 
+g"[ AU, k)", c] 


AU, ,-£€ AU, (k) SAU nx tE 
S.t. 
U nin SA AU y (k) cU, ., < U max 
OSES Emax 
B,"QB,+R 0 
"=| u Q u | 
0 p 
g-[E'QB,. 0], E-A.£(k) 
Al nin Al max 
AU min = At in » AU nax = At na 
Au min Al max ( 10) 
ls, Ü max 
U min = "e s U max = "en 
las - 
ü(k-1) 
ü(k-1) 
U, = 
ü(k-1) 
I, 0 0 0 
L I, 0 0 
A;|i L L 0 
0 
L L L, L, 


2.2 预 瞄 区 域 的 确定 


确定 预 瞄 区 域 是 为 了 提前 发 现 并 适应 前 方 参考 
路 径 弯 曲 程 度 的 变化 ， 以 确保 制 草 机 器 人 做 出 相应 
的 控制 动作 ， 实 现 准确 的 路 径 跟 踪 。 预 瞄 区 域 的 起 
点 由 匹配 点 已 ,(xz， 罗 )(〈 制 草 机 器 人 自身 位 置 距 离 
参考 路 径 最 近 的 点 ) 确定 ， 然 后 根据 割 草 机 器 人 的 
速度 确定 预 瞄 区 域 范围 1/,， 如 图 3 所 示 ,，P,(x,, y,) 
为 预 瞄 区 域 终点 。 

随 着 割 草 机 器 人 速度 增加 ， 其 在 短 时 间 内 行驶 
的 距离 也 相应 增加 。 为 了 精确 预测 未 来 参考 路 径 的 
弯曲 变化 程度 ， 需 适当 增加 预 瞄 区 域 的 范围 ， 以 便 
控制 器 能 够 更 精确 、 更 及 时 地 做 出 控制 决策 。 综 上 
分 析 ， 提 出 预 瞄 区 域 1 的 计算 如 公式 (11) 所 示 。 


liio VEV min 
l,-iav +B, Vran <V < Vinax (11) 
— VZV max 


式 中 :Liww、Lwa 分 别 为 预 瞄 区 域 的 最 小 、 最 大 


图 3 前 方 参考 路 径 的 预 瞄 区 域 
Fig. 3 Preview area of the reference path ahead 
KEE, m; a,，B 为 预 设 常数 ,根据 场地 试验 确定 ; 
Von、Vma 分 别 为 线 速度 最 小 值 与 最 大 值 ，m/s。 
用 折线 段 将 预 瞄 区 域内 的 离散 点 连接 ， 以 便 更 
好 描述 区 域内 的 参考 路 径 弯 曲 变化 程度 ， 如 网 4 
Biz o 


PaGua Yea) 
=œ G5. V3) 
DBE) 
S 
B.) 
9 x 
图 4 前 方 参考 路 径 的 预 瞄 区 域 曲 度 计 算 示意 图 
Fig.4 Schematic diagram of the curvature calculation of the 


preview area of the reference path ahead 


预 瞄 区 域内 相 邻 折线 段 之 间 的 夹 角 计 算 如 公 
式 (12) 所 示 。 


P,P; ` PiyoP iat 


[PP] [Pain 
式 中 : g,e[0, x]; iell, x-1]; x 为 折线 
段 的 数量 。 
为 反映 制 草 机 器 人 在 当前 位 置 处 距离 参考 路 径 
最 近 点 的 弯曲 度 大 小 ， 以 及 整个 预 瞄 区 域内 的 参考 
路 径 弯 曲 变化 情况 ， 分 别 定义 曲 度 因子 上 和 曲 度 变 
化 因子 fA.， 如 公式 (13) 一 公式 (15) 所 示 。 


(12) 


Q; = arccos 


Pı 加 O min 
J (13) 
O max m OQ min 
AQ — AQ, 
= min 14 
f. AQ ~ A nin ( ) 
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1 1 
Ag = Dno) (15) 


式 中 : ous. Qus FAQ max» AQmin 22 BAT 9; Fl Ag 
的 最 大 值 与 最 小 值 ， 根 据 实际 试验 确定 ; 
f,e[O, Ih f el[0, 1]. 

Fe SOT A, Af, OY, SU SB E A 
径 在 匹配 点 处 的 弯曲 程度 以 及 在 整个 预 瞄 区 域内 的 
弯曲 变化 程度 也 就 越 大 。 值 得 注意 的 是 ， 当 预 瞄 区 
域 的 范围 到 达 全 局 参考 路 径 的 终点 了 P,(x,，y,) 时 ， 
此 时 的 预 瞄 区 域 变 为 匹配 点 P(x y.) 5 2X 
P(x, yy,) 的 区 域 , 预 瞄 区 域 的 目标 点 将 停 在 全 局 
参考 路 径 终 点 位 置 ， 如 图 5 所 示 。 此 刻 计算 出 来 的 
.将 作为 割 草 机 器 人 后 续 路 径 跟 踪 过 程 中 的 曲 度 变 
化 因子 ， 直 到 路 径 跟 踊 控 制 结 


P (Xp. Jq) 


参考 路 径 


图 5 前 方 参考 路 径 的 预 瞄 区 域 范围 到 达 参 考 路 径 终 点 


Fig. 5 The extent of the preview area of the reference path 


P(x,. y,) 


ahead reaches the end of the reference path 
2.3 MPC 自 适应 时 域 模块 设计 


2.3.1 MPC 自 适应 时 域 优化 策略 

在 MPC 控 制 系统 中 ， 影 响 路 径 跟 踪 精 度 和 稳 
定性 的 参数 主要 有 预测 时 域 ,和 控制 时 域 Ni 。 
在 实际 路 径 跟 踊 过 程 中 ， 针 对 不 同 的 作用 对 象 或 者 
不 同 的 外 界 环境 ， 需 要 根据 不 同 的 标准 选取 MPC 
时 域 的 大 小 ， 因 此 ， 固 定时 域 的 MPC 并 不 能 满足 
市 草 机 器 人 在 曲线 路 径 跟 踪 作 业 过 程 中 的 控制 精度 
要 求 。 对 此 ， 需 要 针对 性 地 分 析 MPC 时 域 对 割 草 
机 器 人 在 曲线 路 径 跟 踊 控制 过 程 中 的 影响 ， 并 提出 
自 适应 时 域 优化 策略 。 

如 图 6 所 示 ， 在 MPC 控 制 器 其 他 参数 保持 不 变 
的 情况 下 ，WN, 越 大 ，MPC 可 以 在 更 长 时 间 内 预测 
未 来 的 路 径 ， 获 得 更 多 的 制 草 机 器 人 状态 信 
BU, {AUN 过 大 ， 则 会 增 大 割 草 机 器 人 当 
前 位 置 较 远 处 的 误差 权重 ， 导 致 割 草 机 器 人 在 当前 
位 置 附近 的 路 径 跟 踪 精 度 降 低 ， 同 时 也 会 增加 
MPC 算 法 的 计算 量 ， 降 低 系 统 的 实时 性 UOU. fH 
是 ， 如 果 N, 过 小 ， 获 得 的 割 草 机 器 人 未 来 时 刻 的 
状态 信息 过 少 ， 且 存在 系统 控制 量 约束 的 情况 下 ， 


会 导致 割 草 机 需 人 无 法 及 时 转向 ， 路 径 跟 踪 精 度 严 
重 降低 的 同时 ， 稳 定性 也 得 不 到 保证 ， 甚 至 造成 制 
FUR AREE BREL I 


N N 


P P 
= - LJ - r7 
m = a maur SU. 
一 一 参考 路 径 — 参考 路 径 RC 
e BEES Nooo 行驶 路 径 ^ 
a. N,it K b. Nat) 


注 :入 ,为 预测 时 域 。 
图 6 MPC 预测 时 域 对 路 径 跟踪 控制 的 影响 
Fig.6 Influence of MPC prediction horizon on path following 

妆 割 草 机 名 人 的 作业 路 径 弯 曲 程度 较 大 或 弯曲 
变化 较 快 时 ， 即 曲 度 因子 A 和 曲 度 变化 因子 太 较 大 
时 ,意味 着 其 需要 更 时 地 做 出 转弯 或 调整 行驶 方向 
的 决策 。 在 一 定 范围 内 适当 增加 入 ,，MPC 可 以 提 
前 预测 到 未 来 路 径 曲 率 大 小 以 及 曲率 的 变化 ， 同 时 
也 能 更 好 地 考虑 系统 的 动态 响应 延迟 ， 生 成 更 及 时 
的 控制 指令 。 既 保证 了 制 草 机 器 人 在 当前 位 置 附近 
的 路 径 跟踪 精度 在 可 接受 范围 内 适度 降低 ， 同 时 ， 
也 能 够 更 准确 地 跟踪 曲线 路 径 ， 避 免 发 生 失 控 。 而 
当 上 和 大 较 小 ， 即 相对 平 直 时 ， 较 小 的 ,可 以 提高 
割 草 机 带 人 当前 位 置 附近 的 跟 踊 精度 ， 同 时 ， 还 可 
以 在 一 定 程度 上 提高 MPC 算法 的 计算 效率 。 

如 图 7 所 示 ， 当 其 他 控制 参数 不 变 的 情况 下 ， 
N. 越 大 ， 控 制 精度 和 平顺 性 就 越 高 。 但 是 过 大 的 N。 
会 降低 MPC 控 制 器 的 求解 速度 ， 实 时 性 也 随 之 下 
降 。 相 反 ，N, 过 小 时 ,求解 出 的 控制 动作 为 了 保证 
预测 时 域内 割 草 机 器 人 平均 误差 最 小 ， 会 牺牲 割 草 
机 器 人 当前 位 置 附近 路 径 跟踪 精度 IUOS 


N, N, 
ME— — ——— | 
N, N 
m = = =I 
— lw m 一 | 四 -| 77-2. * 
— 参考 路 径 一 一 参考 路 径 Eu 
---- 行驶 路 径 ---- 行驶 路 径 . 
a.N. 过 大 b. Nit) 


È: N. 为 控制 时 域 。 
图 7 控制 时 域 对 路 径 跟踪 控制 的 影响 
Fig.7 Influence of control horizon on path following control 
所 以 ， 在 上 和 大 较 大 时 ， 可 以 适当 增 大 N.， 以 
便 提供 更 多 的 时 间 来 调整 制 草 机 带 人 的 控制 输入 ， 
以 适应 讨 曲 路 径 ， 提 高 控制 精度 和 稳定 性 。 相 反 ， 
则 适当 减少 MX.， 从 而 减少 控制 系统 计算 量 。 
综 上 所 述 ， 提 出 如 下 MPC 自 适 应 时 域 优化 策 
Wr. 采用 模糊 控制 算法 对 时 域 进行 实时 优化 ， 根 据 
预 瞄 区 域内 的 曲 度 因 子 . 和 曲 度 变化 因子 /.， 自 适 
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应 优化 预测 时 域 W。 由 于 控制 时 域 N. 与 预测 时 域 
NN, 是 相互 关联 的 ，N, 的 取 值 一 般 不 超过 N,。 所 以 ， 
根据 所 获得 的 入 ,以 及 .进一步 合理 调整 NN,。 
2.3.2 ”模糊 输入 与 模糊 规则 

经 上 述 分 析 ， 选 择 曲 度 因 子 太 和 曲 度 变化 因子 
作为 模糊 控制 器 的 输入 ，MPC 的 预测 时 域 N, 作 


为 模糊 控制 器 的 输出 。 图 8 分 别 为 模糊 控制 算法 输 
人 和 参数、 输出 参数 的 隶属 函数 图 。 其 中 ， 输 入 量化 
等 级 VL、L、M、H、VH 分 别 表示 为 极 小 、 小 、 
中 、 大 、 极 大 。 输 出 量化 等 级 VS、S、MS、M.、 
ML 、L、VL 分 别 表 示 为 极 短 、 短 、 中 短 、 中 、 中 
长 、 长 、 极 长 。 各 变量 的 论 域 与 量化 因子 如 表 1 
所 示 。 


VL b M H VH VL L 
1.0 1.0 
0.8 0.8 
de 0.6 "TE 
f oa V o4 
0 0.2 
0.0 0.2 0.4 0.6 0.8 1.0 0.0 0.2 
出 度 因子 


a. 曲 度 因子 隶属 函数 


04 06 
曲 度 变 化 因子 
b. 曲 度 变 化 因子 隶属 函数 


0.8 1.0 0.0 0.2 0.8 1.0 


04 06 
预测 时 域 
c. TAM IARA E Dž 


图 8 自 适应 时 域 模块 的 模糊 控制 器 输入 和 输出 隶属 度 函数 


Fig. 8 Membership function of input and output of fuzzy controller for adaptive time horizon module 


表 1 模糊 输入 输出 的 量化 因子 


Table 1 Quantization factor of fuzzy input and output 


变量 HEA Sf, 曲 度 变化 因子 人 预测 时 域 N， 
基本 论 域 [0,1] [0,1] [15,36] 
模糊 论 域 [0,1] [0,1] [0,1] 
量化 因子 1 1 1/21 


根据 自 适 应 时 域 优 化 策略 ， 横 糊 规则 需要 遵循 
以 下 规则 : ARD, ON, ES fA, EK, N, 
越 长 ;其 他 情况 按照 专家 规则 进行 定性 分 析 。 由 此 
设计 模糊 规则 如 表 2 所 示 ; 模糊 控制 的 输入 与 输出 
的 啊 应 曲面 如 图 9 所 示 。 
表 2 MPC 预测 时 域 模糊 规则 
Table 2 Fuzzy rules for the MPC prediction horizon 


f Í: 
7 VL L M H VH 
VL VS S ML L VL 
L S MS ML i VL 
M MS M L VL VL 
H M ML VL VL VL 
VH ML L VL VL VL 


最 终 ， 经 过 模糊 推理 得 到 模糊 输出 量 ， 选 择 重 
心 法 进行 解 模 糊 运 算 ， 得 到 具体 的 预测 时 域 N,， 并 
结合 和 N, 和 .适当 调整 控制 时 域 N.。 根 据 上 述 自 适 
应 时 域 优化 策略 分 析 ， 在 参考 路 径 曲 度 变 化 较 大 情 
况 下 ， 可 以 适当 增 大 N.， 提 高 控制 精度 。 所 以 ， 设 
计 控 制 时 域 表 达 式 如 公式 (16) 所 示 。 

N, = round| AN, (1 + yf) | (16) 

式 中 : 4 为 时 域 权重 系数 ，0 < 4 < 0.5; y 为 曲 


-> 04 
w-— 2 
1.0 00 


0s. 
曲 度 因子 扯 度 变化 因子 


图 9 模糊 控制 器 的 输入 和 输出 响应 曲面 


Fig. 9 Fuzzy controller input and output response surfaces 
度 变 化 增益 系数 ，0 < y < 1。 
2.4 MPC 事件 触发 执行 模块 设计 


对 现 有 的 控制 单元 来 说 ，MPC 的 滚动 优化 求 
解 是 一 个 沉重 的 计算 负担 ”。 为 降低 MPC 求 解 计 
算 量 ， 本 人 研究 引入 事件 触发 执行 机 制 。MPC 通常 
在 每 个 时 间 步 长 都 需要 进行 优化 求解 ,但 是 ， 不 一 
定 需 要 在 每 个 时 间 步 长 都 执行 控制 计算 ， 只 有 在 特 
定 事件 发 生 时 才 执 行 MPC 计 算 ， 否则 可 沿用 上 一 
周期 优化 的 结果 作为 控制 策略 。 通 过 合理 的 触发 条 
件 ， 可 以 在 保证 控制 性 能 的 前 提 下 减少 计算 负担 。 

为 保持 割 草 机 带 人 在 路 径 跟 踪 过 程 中 的 控制 稳 
定性 和 控制 精度 ， 根 据 控制 过 程 的 累计 横向 误差 5S。 
和 累计 航向 误差 Sw 以 及 预 瞄 区 域 的 曲 度 因子 大 与 
曲 度 变化 因子 所 设置 事件 触发 条 件 。 当 预 瞄 区 域 的 
曲 度 因子 与 曲 度 变 化 因子 .小 于 一 定 阐 值 时 ， 才 
开启 MPC 事 件 触发 执行 机 制 。 而 在 参考 路 径 曲 度 
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或 曲 度 变化 程度 较 大 时 ， 需 要 MPC 频繁 在 每 个 采 
样 时 间 进 行 优化 求解 ， 以 便 制 草 机 器 人 更 好 地 应 对 
不 断 变化 的 参考 路 径 ， 从 而 更 好 地 跟踪 路 径 ， 同 时 
维持 稳定 性 。 当 累计 横向 误差 S 和 累计 航向 误差 
Sm 大 于 一 定 国 值 时 ， 重 新 进行 MPC 优化 求解 ， 防 
止 割 草 机 器 人 控制 系统 进入 不 稳定 状态 ， 确 保 割 草 
机 器 人 在 长 期 运动 中 能 够 更 好 地 跟踪 期 望 路 径 。 自 
适应 时 域 MPC 控 制 器 的 事件 触发 执行 机 制 具体 实 
现 伪 代码 如 下 。 


算法 :MPC 事 件 触发 执行 机 制 


1. 初始 化 :设置 触发 条 件 闷 值 :横向 误差 阅 值 thr,、 航 向 误差 阅 值 
thr pnis WEE F EIIE thre MEZAT E threo ENIRE RTT 
KAS: Qoar Qepni 

2. while 未 到 达 参 考 路 径 终 点 

3. 将 横向 误差 ed 和 航向 误差 ephi 分 别 存 人 缓 存 队列 CO. Qu; 

4.if f, > thr, orf, > trig 

5. MPC 求 解 最 优 控 制 序列 U(1:mXN,) ,并 将 U(1:m) 作 为 控制 输 
入 ,清空 误差 缓存 队列 :OO 

6. else 

7. MSES,, = sum [abs (Qu) } Sep; = sum [abs (Qus) ] 

8. 让 第 一 次 运行 

9. MPC 求 解 最 优 控 制 序列 U(1:mXN.) 

10. else 

11. If S4, > thra or Suy > Hr opri OF size( U)<m 

12. MPC OR SPEECH Hil FEI UCL mX N.) ,清空 误差 缓存 队列 : 0、 
Q. hi 

13 end if 

14. end if 

15. 将 U(1:m) 作 为 控制 输入 

16. 将 控制 序列 前 m 个 移 除 得 到 U(m+l : end) 

17. end if 

18. end while 


MPC 触发 执行 机 制 的 引入 虽然 是 在 每 个 采样 
时 间 加 入 一 步 额外 计算 ,但 是 事件 触发 的 本 质 是 逻 
辑 判断 ， 其 算法 计算 量 远 远 小 于 MPC 在 每 个 采样 
时 间 进 行 的 滚动 优化 求解 的 计算 量 ， 所 以 引入 
MPC 解 发 执行 机 制 可 以 有 效 节 约 计算 资源 。 


3 试验 验证 
3.1 试验 平台 


为 验证 提出 的 控制 算法 的 有 效 性 ， 在 自主 设计 
的 割 草 机 器 人 平台 上 进行 试验 (图 10)。 割 草 机 器 
人 的 运动 方式 为 差 速 驱动 转向 ， 通 过 调节 两 独立 直 
流 伺 服 电机 的 转速 ， 再 经 过 链条 传动 到 后 轮 ， 从 而 
实现 运动 控制 。 前 轮 采用 端面 轴承 连接 ， 能 够 实现 
360" 灵 活 转 动 。 割 草 机 器 人 后 轮 半径 为 0.215 m, 
后 轮 轮 距 为 1.034 m。 该 平台 上 配备 了 英 伟 达 Jet- 
son Xavier NX 控制 主机 、16 线 velodyne 激 光 雷 达 、 
惯性 测量 单元 (Inertial Measurement Unit, IMU) , 
额定 功率 2 000 W 和 额定 转速 100 r/min 的 直流 伺服 


电机 ， 同 时 直流 伺服 电机 自 带 双 驱 伺服 控制 占 ， 文 
持 增 量 式 编码 器 与 霍 尔 元 带 件 等 多 种 反馈 元 件 。 


i m 


图 10 割 草 机 器 人 平台 

Fig. 10 Mowing robot platform 
MPU UNA Stas, FESS aaa Fae 
电机 、 电 推 杆 等 组 成 。 根 据 割 草 机 器 人 整 机 宽度 ， 
筛选 合适 的 割 草 刀 盘 ， 选 择 的 割 草 刀 盘 作业 宽度 为 
1 m， 切 割 部 分 由 两 个 长 0.7 mm 的 刀片 构成 ， 具 有 向 
右 侧 排 草 功能 。 将 两 台 割 草 电机 安装 在 刀片 转轴 正 
上 方 ， 通 过 联 轴 带 将 电机 输出 轴 与 转轴 相连 ， 实 现 
电机 直接 驱动 进行 割 草 作业 。 此 外 ， 为 了 适应 不 同 
草坪 ， 通 过 控制 电 推 杆 的 伸缩 长 得 ， 来 调节 割 草 刀 
盘 的 高 度 。 当 电 推 杆 拉 长 或 缩短 时 ， 带 动 旋转 三 角 
板 往 上 或 往 下 移动 ， 使 得 链条 可 以 拖 动 制 草 刀 盘 上 
下 运动 ， 从 而 能 够 更 好 满足 不 同 割 草 高 度 的 作业 
要 求 。 


All 害 草 机 构 


Fig. 11 Structure of lawn mower 


试验 算法 在 机 器 人 操作 系统 (Robot Operating 
System, ROS) 上 进行 验证 ， 通 过 在 ROS 上 搭建 路 
径 跟 踪 控 制 节点 发 布 制 草 机 右 人 运动 控制 指令 ， 青 
利用 直流 伺服 电机 驱动 器 的 串口 协议 ， 向 左右 后 轮 
驱动 电机 发 送 最 终 速 度 控制 指令 ， 从 而 实现 割 草 机 
器 人 的 路 径 跟踪 控制 。 割 草 机 吉 人 的 定位 主要 采用 
LeGO-LOAM (Lightweight and Groud-Optimized Li- 
dar Odometry and Mapping on Variable Terrain) 算 
法 后， 根据 激光 雷达 和 IMU 传感器 数据 ， 来 实时 
获取 制 草 机 器 人 的 位 姿 信 息 ， 以 及 根据 直流 伺服 电 
机 自 带 的 反馈 元 件 来 获取 制 草 机 带 人 速度 信息 。 
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3.2 试验 设置 


割 草 机 器 人 主要 采用 往复 式 路 径 进行 作业 ， 包 
括 直线 路 径 以 及 掉头 转弯 的 曲线 路 径 ， 所 以 采用 如 
图 12 所 示 的 S 形 路 径 作为 参考 路 径 进 行 跟踪 控制 测 
试 。 并 根据 割 草 机 融 人 的 割 草 刀 盘 作业 宽度 ， 设 置 
两 段 参考 直线 路 径 间 距 为 1m， 曲 线路 径 的 曲率 为 
2m'。 同 时 为 了 保证 割 草 质量 ,其 中 直线 路 径 的 参 
考 速度 设置 为 1 m/s， 曲 线路 径 的 参考 速度 设置 为 
0.5 m/s。 根 据 参考 路 径 以 及 割 草 机 器 人 结构 斥 十 ， 
试验 场地 选择 如 图 13 所 示 的 一 处 草坪 。 


图 12 割 草 机 器 人 路 径 跟 踪 试 验 参 考 路 径 
Fig. 12 Reference path for path tracking test of mowing robot 


图 13 害 草 机 器 人 路 径 跟 踪 实地 测试 
Fig. 13 Field testing of path tracking for mowing robots 


本 研究 设置 了 4 组 固定 时 域 MPC 控 制 器 进行 对 
比试 验 ， 条 件 如 下 。 第 1 组 : N, = 14、N.=5; 第 
24: N,222. N.=14; 第 3 组 : N,=27, 
N,221; 第 4 组 : N,=32、N.=27。 为 了 更 好 地 
比较 不 同 对 照 组 的 控制 性 能 ， 引 入 最 大 横向 误差 绝 
对 值 Euss、 横 向 误差 绝对 值 均值 Ew、 横 向 误差 绝 
对 值 标准 差 £4、 最 大 航向 误差 绝对 值 Bo 、 航 向 
误差 绝对 值 均 值 5。,、 横 向 误差 绝对 值 标准 差 E。、 
MPC 平 均 求解 时 间 等 性 能 指标 对 跟踪 效果 进行 评 
价 。 同 时 在 试验 中 ,本 研究 所 设计 的 控制 器 的 主要 
控制 参数 如 表 3 所 示 。 


3.3 试验 结果 与 分 析 


当 MPC 选择 不 同 固定 时 域 与 自 适应 时 域 时 ， 
对 参考 路 径 的 跟踪 效果 也 存在 一 定 差异 。 从 图 14 
中 可 以 看 出 ， 采 用 4 组 固定 时 域 与 自 适应 时 域 均 能 
跟踪 参考 路 径 ， 但 在 不 同 路 段 的 跟踪 效果 有 所 不 
同 。 当 割 草 机 器 人 由 直线 段 进 入 第 1 个 曲线 路 径 进 
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表 3 割 草 机 器 人 自 适应 时 域 MPC 控制 试验 参数 
Table 3 Experimental parameters for adaptive time horizon 


MPC control of mowing robots 


参数 数值 
采样 周期 Ts 0.1 
$B: Q 100 Ty, 
ALE AGRE R Ly 
PAIE DS] TEL € max 1 
松弛 因子 权重 系数 p 10 
最 大 线 速度 vi,/(m/s) 2 
最 小 线 速度 vi/(m/s) 0.3 
预 眶 区 域 最 小 长 度 1%,/m 1.5 
TI DC ER AC I REL. /m 5 
时 域 权重 系数 4 0.5 
曲 度 变化 增益 系数 ) 0.8 
HERZ BJE thr a 0.02 
JRE B fH thr opni 0.02 
HH BEIT BJE thre 0.5 
H REZE BSB (B thr pe 0.5 


行 转弯 掉头 时 ， 较 大 的 时 域 能 够 提前 预测 未 来 曲率 
的 变化 情况 ， 会 更 早 地 进行 转弯 控制 ， 由 于 第 4 组 
与 自 适应 时 域 在 曲线 段 的 时 域 最 大 ， 故 在 此 段 路 径 
的 偏离 距离 最 小 。 而 第 1 组 和 第 2 组 由 于 时 域 较 小 ， 
割 草 机 器 人 难以 及 时 转向 ， 偏 离 参 考 路 径 较 大 。 第 
3 组 偏离 距离 居中 。 与 此 类 似 ， 当 制 草 机 器 人 进入 
第 2 个 曲线 路 径 时 ， 时 域 最 短 的 第 1 组 偏离 参考 路 
径 最 远 ， 而 自 适应 时 域 由 于 可 以 根据 前 方 路 径 曲率 
以 及 曲率 变化 情况 自 适应 调节 时 域 大 小 ， 故 能 够 相 
对 及 时 地 进行 转弯 掉头 。 


2,5531 
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图 14 割 草 机 器 人 期 望 路 径 的 跟踪 效果 对 比 
Fig. 14 Comparison of tracking effects on the expected path of 


mowing robots 


AAN, HATERS METAB La A eR EE Re PAY 
误差 ， 也 能 够 直观 显示 不 同时 域 对 照 组 与 自 适应 时 
域 的 控制 效果 ， 如 图 15 所 示 ， 时 域 越 大 ， 横 向 误 
差 和 航向 误差 的 峰值 以 及 整体 零 偏 幅度 越 小 。 在 对 
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照 组 中 ， 由 于 第 4 组 时 域 最 大 ,横向 误差 和 航向 误 
差 的 峰值 和 零 偏 幅 度 最 小 ， 跟 踪 效 果 最 好 ， 而 本 研 
究 的 自 适应 时 域 MPC 控 制 絮 的 跟踪 效果 比 第 4 组 固 
定时 域 更 好 。 在 设计 的 MPC 控制 嚣 中， 预测 时 域 
与 控制 时 域 能 够 随 曲 度 因 子 ， 以 及 曲 度 变化 因子 自 
适应 调节 ， 是 重要 的 创新 点 之 一 。 从 图 16 和 图 17 
可 以 看 出 ， 预 测 时 域 为 16~36， 而 控制 时 域 为 8 一 
31。 在 参考 路 径 的 曲率 以 及 曲率 变化 较 大 的 地 方 ， 
MPC 自 适 应 时 域 模块 会 及 时 适当 增 大 预测 时 域 与 
控制 时 域 ， 以 适应 参考 路 径 曲 率 的 变化 ， 进 而 提高 
割 草 机 器 人 对 曲线 路 径 的 跟踪 控制 精度 。 相 反 ， 则 
会 适当 减少 时 域 ， 以 降低 控制 絮 的 计算 负载 。 


0.3 


02r 
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b. 航向 误差 对 比 
图 15 着 草 机 器 人 路 径 跟踪 误差 对 比 图 


Fig. 15 Comparison chart of path tracking errors for mowing robots 


表 4 统 计 了 不 同时 域 对 照 组 和 自 适 应 时 域 在 不 
同 控制 性 能 指标 下 的 数据 。 可 以 看 出 ， 对 照 组 中 ， 
第 4 组 在 跟踪 控制 精度 方面 最 好 ; 第 1 组 的 控制 效 
果 最 差 ; 第 2 组 和 第 3 组 各 项 数据 适中 。 但 是 ， 由 
于 第 4 组 的 时 域 最 大 ，MPC 的 求解 计算 量 也 最 大 ， 
平均 求解 时 间 达 到 0.015 8s， 而 第 1 组 的 求解 时 
H ta HA 0.006 7 s。 相 较 于 固定 时 域 ， 本 研究 设计 
的 自 适 应 时 域 MPC 控制 带 的 最 大 横向 误差 绝对 
MEL E amas 和 最 大 航向 误差 绝对 值 5 分 别 控 制 在 了 
11 cm 410.13 rad 以 内 ， 比 固定 时 域 对 照 组 都 要 小 。 


BEDS 
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度 变 化 因子 
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b. 曲 度 变化 因子 
图 16 预 瞄 区 域 的 曲 度 因 子 及 曲 度 变 化 因子 


Fig. 16 Curvature factor and curvature variation factor of the 
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图 17 自 适应 时 域 MPC 的 预测 时 域 与 控制 时 域 自 适 应 变化 
Fig.17 Adaptive time horizon MPC with predictive time 


horizon and control time horizon adaptive changes 


同时 ， 自 适应 时 域 MPC 控 制 器 的 横向 误差 绝对 值 
HJE E, 和 航 回 误差 绝对 值 均 值 已 , 比 第 1 组 分 别 减 
少 75.39% 和 57.83%， 比 第 4 组 分 别 减少 38.38% 和 
31.84%。 并 且 ， 自 适应 时 域 MPC 控 制 器 的 横向 误 
差 绝 对 值 标准 差 E 和 航向 误差 绝对 值 标 准 差 EB, 分 
别 只 有 0.025 6m 和 0.025 5 rad, 均 比 4 组 固定 时 域 
MPC 控制 器 的 EE 和 Es 要 小 ， 表 明 跟 踪 误 差 被 控制 
在 较 小 范围 内 ， 有 效 保 证 了 制 草 机 器 人 跟踪 控制 精 
度 。 同 时 自 适应 时 域 MPC 的 平均 求解 时 间 刀 只 
0.0049 s， 比 最 大 时 域 第 4 组 减少 了 10.9 ms， 有 效 
降低 了 计算 负荷 。 由 图 18 和 图 19 可 以 看 出 ， 在 参 
考 路 径 曲 率 和 曲率 变化 率 较 小 处 ，MPC 执行 触发 
的 次 数 较 少 。 相 反 ，MPC 执行 触发 的 次 数 越 多 ， 
在 保证 控制 精度 和 稳定 性 的 前 提 下 ， 进 一 步 减少 了 
控制 句 的 计算 量 。 
4 结 论 

为 解决 传统 固定 时 域 MPC 时 域 调节 与 计算 量 
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表 4 割 草 机 器 人 试验 固定 时 域 与 自 适 应 时 域 MPC 控制 性 能 
Table 4 MPC Control performance of fixed time horizon and 


adaptive time horizon in mowing robot experiment 


整个 MPC 计算 求解 资源 。 同 时 设计 的 MPC 事 件 触 
发 执行 机 制 能 够 根据 前 方 预 瞄 区 域 的 曲 度 与 曲 度 变 
化 因子 以 及 累计 误差 ， 在 保证 控制 精度 与 稳定 性 的 


, » 第 1 2822 5832 Hz 
MPC fth ET 33 第 1 组 ”第 2 组 3 组 4 组 上 适应 
N,=14 N,-22 N,-27 N,=32 M * 
MPC 控 制 时 域 N25 N=14 N,221 N,=27 
E gay 0.2572 0.1978 0.1459 0.1254 0.1045 
E,,/m 0.0711 0.0465 0.0327 0.0284 0.0175 
E,/m 0.0828 0.0606 0.0419 0.0330 0.0256 
Egmaltad 0.2365 0.1748 0.1528 0.1403 0.1283 
E,/rad 0.0396 0.0337 0.0278 0.0245 0.0167 
Ex/rad 0.0410 0.0375 0.0350 0.0294 0.0255 
t, Js 0.0067 0.0103 0.0126 0.0158 0.0049 
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图 18 割 草 机 器 人 路 径 跟 踪 中 的 参考 路 径 曲率 


Fig.18 Reference path curvature in mowing robots path tracking 
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图 19 自 适 应 时 域 MPC 控 制 器 的 事件 触发 执行 次 数 变 化 


Fig. 19 Changes in event triggering execution times of adaptive 


time horizon MPC controller 


之 间 的 矛盾 ， 以 及 提高 制 草 机 如 人 对 于 曲线 路 径 的 
跟踪 精度 ， 本 研究 提出 一 种 自 适 应 时 域 MPC 路 径 
跟踪 控制 方法 ， 并 在 自主 设计 的 割 草 机 融 人 试验 平 
台 进 行 了 验证 ， 主 要 结论 如 下 。 

1) 设计 的 自 适应 时 域 MPC 控 制 器 能 够 根据 前 
方 预 瞄 区 域 的 曲 度 因 子 以 及 曲 度 变化 因子 ， 利 用 模 
糊 控 制 器 自 适应 优化 MPC 的 预测 时 域 , 并 根据 预 
测 时 域 和 曲 度 变化 因子 适当 调整 控制 时 域 ， 在 保证 
割 草 机 器 人 对 曲线 路 径 跟 踪 精 度 的 同时 ， 有 效 降 低 


前 提 下 ， 进 一 步 降 低 MPC 的 计算 量 。 

2) 自 适 应 时 域 MPC 控 制 器 的 最 大 横向 误差 绝 
对 值 和 最 大 航向 误差 绝对 值 分 别 控制 在 11 cm 和 
0.13 rad 以 内 ， 表 明 该 控制 器 能 够 使 制 草 机 器 人 有 
效 跟 踪 曲 率 变化 较 大 的 曲线 路 径 ， 并 实现 自主 
作业 。 

3) 与 最 大 固定 时 域 MPC 对照 组 相 比 ， 自 适应 
时 域 MPC 控 制 器 的 平均 求解 时 间 减 少 10.9 ms， 有 
效 降低 了 MPC 的 计算 负荷 ， 提 高 控制 的 实时 性 。 
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Abstract: 

[Objective] The traditional predictive control approach usually employs a fixed time horizon and often overlooks the impact of chang- 
es in curvature and road bends. This oversight leads to subpar tracking performance and inadequate adaptability of robots for navigat- 
ing curves and paths. Although extending the time horizon of the standard fixed time horizon model predictive control (MPC) can im- 
prove curve path tracking accuracy, it comes with high computational costs, making it impractical in situations with restricted comput- 
ing resources. Consequently, an adaptive time horizon MPC controller was developed to meet the requirements of complex tasks such 
as autonomous mowing. 

[Methods] Initially, it was crucial to establish a kinematic model for the mowing robot, which required employing Taylor linearization 
and Euler method discretization techniques to ensure accurate path tracking. The prediction equation for the error model was derived 
after conducting a comprehensive analysis of the robot's kinematics model employed in mowing. Second, the size of the previewing 
area was determined by utilizing the speed data and reference path information gathered from the mowing robot. The region located a 
certain distance ahead of the robot's current position, was identified to as the preview region, enabling a more accurate prediction of 
the robot's future traveling conditions. Calculations for both the curve factor and curve change factor were carried out within this pre- 
view region. The curvature factor represented the initial curvature of the path, while the curvature change factor indicated the extent of 
curvature variation in this region. These two variables were then fed into a fuzzy controller, which adjusted the prediction time hori- 
zon of the MPC. The integration enabled the mowing robot to promptly adjust to changes in the path's curvature, thereby improving its 
accuracy in tracking the desired trajectory. Additionally, a novel technique for triggering MPC execution was developed to reduce 
computational load and improve real-time performance. This approach ensured that MPC activation occurred only when needed, rath- 
er than at every time step, resulting in reduced computational expenses especially during periods of smooth robot motion where unnec- 
essary computation overhead could be minimized. By meeting kinematic and dynamic constraints, the optimization algorithm success- 
fully identified an optimal control sequence, ultimately enhancing stability and reliability of the control system. Consequently, these 
set of control algorithms facilitated precise path tracking while considering both kinematic and dynamic limitations in complex envi- 
ronments. 

[Results and Discussion] The adaptive time-horizon MPC controller effectively limited the maximum absolute heading error and maxi- 
mum absolute lateral error to within 0.13 rad and 11 cm, respectively, surpassing the performance of the MPC controller in the control 
group. Moreover, compared to both the first and fourth groups, the adaptive time-horizon MPC controller achieved a remarkable re- 
duction of 75.39% and 57.83% in mean values for lateral error and heading error, respectively (38.38% and 31.84%, respectively). Ad- 
ditionally, it demonstrated superior tracking accuracy as evidenced by its significantly smaller absolute standard deviation of lateral er- 
ror (0.025 6 m) and course error (0.025 5 rad), outperforming all four fixed time-horizon MPC controllers tested in the study. Further- 
more, this adaptive approach ensured precise tracking and control capabilities for the mowing robot while maintaining a remarkably 
low average solution time of only 0.004 9 s, notably faster than that observed with other control data sets-reducing computational load 
by approximately 10.9 ms compared to maximum time-horizon MPC. 

[Conclusions] The experimental results demonstrated that the adaptive time-horizon MPC tracking approach effectively addressed the 
trade-off between control accuracy and computational complexity encountered in fixed time-horizon MPC. By dynamically adjusting 
the time horizon length the and performing MPC calculations based on individual events, this approach can more effectively handle 
scenarios with restricted computational resources, ensuring superior control precision and stability. Furthermore, it achieves a balance 
between control precision and real-time performance in curve route tracking for mowing robots, offering a more practical and reliable 
solution for their practical application. 
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